API tools faq
paste
Advertisement
lcvette

XK7130 Hal for servo drive tuning

lcvette
Jun 21st, 2018
170
0
Never
Add comment
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 17.94 KB | None | 0 0
raw download clone embed print report
  1. # Generated by PNCconf at Thu Nov 9 12:55:45 2017
  2. # If you make changes to this file, they will be
  3. # overwritten when you run PNCconf again
  4.  
  5. loadrt trivkins
  6. loadrt [EMCMOT]EMCMOT servo_period_nsec=[EMCMOT]SERVO_PERIOD num_joints=[TRAJ]AXES num_dio=16
  7. loadrt hostmot2
  8. loadrt hm2_eth board_ip="10.10.10.10" config=" num_encoders=6 num_pwmgens=0 num_stepgens=5 sserial_port_0=00000x"
  9. setp hm2_7i92.0.watchdog.timeout_ns 5000000
  10. loadrt pid names=pid.x,pid.y,pid.z,pid.a,pid.s
  11. loadrt abs names=abs.spindle
  12. loadrt lowpass names=lowpass.spindle
  13. loadrt scale names=scale.spindle
  14. loadrt near
  15. loadrt xor2 count=4
  16.  
  17. addf hm2_7i92.0.read servo-thread
  18. addf motion-command-handler servo-thread
  19. addf motion-controller servo-thread
  20. addf pid.x.do-pid-calcs servo-thread
  21. addf pid.y.do-pid-calcs servo-thread
  22. addf pid.z.do-pid-calcs servo-thread
  23. addf pid.a.do-pid-calcs servo-thread
  24. addf pid.s.do-pid-calcs servo-thread
  25. addf scale.spindle servo-thread
  26. addf abs.spindle servo-thread
  27. addf lowpass.spindle servo-thread
  28. addf near.0 servo-thread
  29. addf hm2_7i92.0.write servo-thread
  30. addf xor2.0 servo-thread
  31. addf xor2.1 servo-thread
  32.  
  33. setp hm2_7i92.0.dpll.01.timer-us -100
  34. setp hm2_7i92.0.stepgen.timer-number 1
  35. setp hm2_7i92.0.encoder.timer-number 1
  36.  
  37. # external output signals
  38.  
  39. # --- DIGITAL OUTPUT ---
  40. net atc-out hm2_7i92.0.7i76.0.3.output-07 <= motion.digital-out-00
  41. net atc-in hm2_7i92.0.7i76.0.3.output-08 <= motion.digital-out-01
  42.  
  43. # --- INCLUDES MANUAL TOOL RELEASE BUTTON INPUT BELOW ---
  44. net unclamp-tool-button xor2.0.in0 <= hm2_7i92.0.7i76.0.3.input-06
  45. net unclamp-tool-toolchange xor2.0.in1 <= motion.digital-out-02
  46. net drawbar-release hm2_7i92.0.7i76.0.3.output-03 <= xor2.0.out
  47. net atc-fwd hm2_7i92.0.7i76.0.3.output-05 <= motion.digital-out-03
  48. net atc-rev hm2_7i92.0.7i76.0.3.output-06 <= motion.digital-out-04
  49.  
  50. # --- SPINDLE ORIENT BEGIN ---
  51. net spindle-orient-start motion.spindle-orient hm2_7i92.0.7i77.0.0.output-08
  52.  
  53. # --- SPINDLE-ENABLE ---
  54. net spindle-enable hm2_7i92.0.7i77.0.0.output-09
  55.  
  56. # --- SPINDLE lOCKED ---
  57. net spindle-locked motion.spindle-locked hm2_7i92.0.7i77.0.0.output-11
  58.  
  59. # --- X-ENABLE ---
  60. net x-enable hm2_7i92.0.7i76.0.3.output-12
  61.  
  62. # --- Y-ENABLE ---
  63. net y-enable hm2_7i92.0.7i76.0.3.output-13
  64.  
  65. # --- Z-ENABLE ---
  66. net z-enable hm2_7i92.0.7i76.0.3.output-14
  67.  
  68. # --- A-ENABLE ---
  69. net a-enable hm2_7i92.0.7i76.0.3.output-15
  70.  
  71. # --- Z-ENABLE ---
  72. net z-enable hm2_7i92.0.7i76.0.3.output-01
  73.  
  74. # --- COOLANT-FLOOD ---
  75. net coolant-flood hm2_7i92.0.7i76.0.3.output-04
  76.  
  77. # external input signals
  78.  
  79. # --- SPINDLE ORIENT ENDED ---
  80. net spindle-orient-end motion.spindle-is-oriented hm2_7i92.0.7i77.0.0.input-31
  81.  
  82. # --- ESTOP-EXT ---
  83. net estop-ext <= hm2_7i92.0.7i76.0.3.input-21
  84.  
  85. # --- PROBE-IN ---
  86. net probe-in <= hm2_7i92.0.7i77.0.0.input-15
  87.  
  88. # --- DIGITAL INPUTS ---
  89. net atc-is-in hm2_7i92.0.7i76.0.3.input-01 <= motion.digital-in-00
  90.  
  91. net atc-is-out hm2_7i92.0.7i76.0.3.input-00 <= motion.digital-in-01
  92.  
  93. net atc-zero hm2_7i92.0.7i76.0.3.input-03 <= motion.digital-in-03
  94.  
  95. net atc-index hm2_7i92.0.7i76.0.3.input-02 <= motion.digital-in-04
  96.  
  97. net tool-released hm2_7i92.0.7i76.0.3.input-05 <= motion.digital-in-02
  98.  
  99. net tool-clamped hm2_7i92.0.7i76.0.3.input-07 <= motion.digital-in-05
  100.  
  101. # --- HOME-Z ---
  102. net home-z <= hm2_7i92.0.7i77.0.0.input-05-not
  103.  
  104. # --- LIMIT-Z ---
  105. net limit-z <= hm2_7i92.0.7i77.0.0.input-04-not
  106.  
  107. # --- HOME-Y ---
  108. net home-y <= hm2_7i92.0.7i77.0.0.input-03-not
  109.  
  110. # --- LIMIT-Y ---
  111. net limit-y <= hm2_7i92.0.7i77.0.0.input-02-not
  112.  
  113. # --- HOME-X ---
  114. net home-x <= hm2_7i92.0.7i77.0.0.input-01-not
  115.  
  116. # --- LIMIT-X ---
  117. net limit-x <= hm2_7i92.0.7i77.0.0.input-00-not
  118.  
  119. #*******************
  120. # AXIS X
  121. #*******************
  122.  
  123. setp pid.x.Pgain [AXIS_0]P
  124. setp pid.x.Igain [AXIS_0]I
  125. setp pid.x.Dgain [AXIS_0]D
  126. setp pid.x.bias [AXIS_0]BIAS
  127. setp pid.x.FF0 [AXIS_0]FF0
  128. setp pid.x.FF1 [AXIS_0]FF1
  129. setp pid.x.FF2 [AXIS_0]FF2
  130. setp pid.x.deadband [AXIS_0]DEADBAND
  131. setp pid.x.maxoutput [AXIS_0]MAX_OUTPUT
  132. setp pid.x.error-previous-target true
  133. setp pid.x.maxerror 0
  134.  
  135. net x-index-enable <=> pid.x.index-enable
  136. net x-enable => pid.x.enable
  137. net x-pos-cmd => pid.x.command
  138. net x-vel-cmd => pid.x.command-deriv
  139. net x-pos-fb => pid.x.feedback
  140. net x-output => pid.x.output
  141.  
  142. # Step Gen signals/setup
  143.  
  144. setp hm2_7i92.0.stepgen.00.dirsetup [AXIS_0]DIRSETUP
  145. setp hm2_7i92.0.stepgen.00.dirhold [AXIS_0]DIRHOLD
  146. setp hm2_7i92.0.stepgen.00.steplen [AXIS_0]STEPLEN
  147. setp hm2_7i92.0.stepgen.00.stepspace [AXIS_0]STEPSPACE
  148. setp hm2_7i92.0.stepgen.00.position-scale [AXIS_0]STEP_SCALE
  149. setp hm2_7i92.0.stepgen.00.step_type 0
  150. setp hm2_7i92.0.stepgen.00.control-type 1
  151. setp hm2_7i92.0.stepgen.00.maxaccel [AXIS_0]STEPGEN_MAXACCEL
  152. setp hm2_7i92.0.stepgen.00.maxvel [AXIS_0]STEPGEN_MAXVEL
  153.  
  154. # ---closedloop stepper signals---
  155.  
  156. net x-pos-cmd <= axis.0.motor-pos-cmd
  157. net x-vel-cmd <= axis.0.joint-vel-cmd
  158. net x-output <= hm2_7i92.0.stepgen.00.velocity-cmd
  159. net x-pos-fb <= hm2_7i92.0.stepgen.00.position-fb
  160. ##net x-pos-fb <= hm2_7i92.0.encoder.01.position
  161. net x-pos-fb => axis.0.motor-pos-fb
  162. net x-enable <= axis.0.amp-enable-out
  163. net x-enable => hm2_7i92.0.stepgen.00.enable
  164.  
  165. # ---Encoder feedback signals/setup---
  166.  
  167. setp hm2_7i92.0.encoder.01.counter-mode 0
  168. setp hm2_7i92.0.encoder.01.filter 1
  169. setp hm2_7i92.0.encoder.01.index-invert 0
  170. setp hm2_7i92.0.encoder.01.index-mask 0
  171. setp hm2_7i92.0.encoder.01.index-mask-invert 0
  172. setp hm2_7i92.0.encoder.01.scale [AXIS_0]ENCODER_SCALE
  173.  
  174. # ****the following line is for drive tuning purposes only****
  175. net x-encpos-fb <= hm2_7i92.0.encoder.01.position
  176. net x-vel-fb <= hm2_7i92.0.encoder.01.velocity
  177. net x-pos-fb => axis.0.motor-pos-fb
  178. net x-index-enable axis.0.index-enable <=> hm2_7i92.0.encoder.01.index-enable
  179. net x-pos-rawcounts <= hm2_7i92.0.encoder.01.rawcounts
  180.  
  181. # ---setup home / limit switch signals---
  182.  
  183. net home-x => axis.0.home-sw-in
  184. net limit-x => axis.0.neg-lim-sw-in
  185.  
  186. #*******************
  187. # AXIS Y
  188. #*******************
  189.  
  190. setp pid.y.Pgain [AXIS_1]P
  191. setp pid.y.Igain [AXIS_1]I
  192. setp pid.y.Dgain [AXIS_1]D
  193. setp pid.y.bias [AXIS_1]BIAS
  194. setp pid.y.FF0 [AXIS_1]FF0
  195. setp pid.y.FF1 [AXIS_1]FF1
  196. setp pid.y.FF2 [AXIS_1]FF2
  197. setp pid.y.deadband [AXIS_1]DEADBAND
  198. setp pid.y.maxoutput [AXIS_1]MAX_OUTPUT
  199. setp pid.y.error-previous-target true
  200. setp pid.y.maxerror 0
  201.  
  202. net y-index-enable <=> pid.y.index-enable
  203. net y-enable => pid.y.enable
  204. net y-pos-cmd => pid.y.command
  205. net y-vel-cmd => pid.y.command-deriv
  206. net y-pos-fb => pid.y.feedback
  207. net y-output => pid.y.output
  208.  
  209. # Step Gen signals/setup
  210.  
  211. setp hm2_7i92.0.stepgen.01.dirsetup [AXIS_1]DIRSETUP
  212. setp hm2_7i92.0.stepgen.01.dirhold [AXIS_1]DIRHOLD
  213. setp hm2_7i92.0.stepgen.01.steplen [AXIS_1]STEPLEN
  214. setp hm2_7i92.0.stepgen.01.stepspace [AXIS_1]STEPSPACE
  215. setp hm2_7i92.0.stepgen.01.position-scale [AXIS_1]STEP_SCALE
  216. setp hm2_7i92.0.stepgen.01.step_type 0
  217. setp hm2_7i92.0.stepgen.01.control-type 1
  218. setp hm2_7i92.0.stepgen.01.maxaccel [AXIS_1]STEPGEN_MAXACCEL
  219. setp hm2_7i92.0.stepgen.01.maxvel [AXIS_1]STEPGEN_MAXVEL
  220.  
  221. # ---closedloop stepper signals---
  222.  
  223. net y-pos-cmd <= axis.1.motor-pos-cmd
  224. net y-vel-cmd <= axis.1.joint-vel-cmd
  225. net y-output <= hm2_7i92.0.stepgen.01.velocity-cmd
  226. net y-pos-fb <= hm2_7i92.0.stepgen.01.position-fb
  227. #net y-pos-fb <= hm2_7i92.0.encoder.02.position
  228. net y-pos-fb => axis.1.motor-pos-fb
  229. net y-enable <= axis.1.amp-enable-out
  230. net y-enable => hm2_7i92.0.stepgen.01.enable
  231.  
  232. # ---Encoder feedback signals/setup---
  233.  
  234. setp hm2_7i92.0.encoder.02.counter-mode 0
  235. setp hm2_7i92.0.encoder.02.filter 1
  236. setp hm2_7i92.0.encoder.02.index-invert 0
  237. setp hm2_7i92.0.encoder.02.index-mask 0
  238. setp hm2_7i92.0.encoder.02.index-mask-invert 0
  239. setp hm2_7i92.0.encoder.02.scale [AXIS_1]ENCODER_SCALE
  240.  
  241. # ****the following line is for drive tuning purposes only****
  242. net y-encpos-fb <= hm2_7i92.0.encoder.02.position
  243. net y-vel-fb <= hm2_7i92.0.encoder.02.velocity
  244. net y-pos-fb => axis.1.motor-pos-fb
  245. net y-index-enable axis.1.index-enable <=> hm2_7i92.0.encoder.02.index-enable
  246. net y-pos-rawcounts <= hm2_7i92.0.encoder.02.rawcounts
  247.  
  248. # ---setup home / limit switch signals---
  249.  
  250. net home-y => axis.1.home-sw-in
  251. net limit-y => axis.1.neg-lim-sw-in
  252.  
  253.  
  254. #*******************
  255. # AXIS Z
  256. #*******************
  257.  
  258. setp pid.z.Pgain [AXIS_2]P
  259. setp pid.z.Igain [AXIS_2]I
  260. setp pid.z.Dgain [AXIS_2]D
  261. setp pid.z.bias [AXIS_2]BIAS
  262. setp pid.z.FF0 [AXIS_2]FF0
  263. setp pid.z.FF1 [AXIS_2]FF1
  264. setp pid.z.FF2 [AXIS_2]FF2
  265. setp pid.z.deadband [AXIS_2]DEADBAND
  266. setp pid.z.maxoutput [AXIS_2]MAX_OUTPUT
  267. setp pid.z.error-previous-target true
  268. setp pid.z.maxerror 0
  269.  
  270. net z-index-enable <=> pid.z.index-enable
  271. net z-enable => pid.z.enable
  272. net z-pos-cmd => pid.z.command
  273. net z-vel-cmd => pid.z.command-deriv
  274. net z-pos-fb => pid.z.feedback
  275. net z-output => pid.z.output
  276.  
  277. # Step Gen signals/setup
  278.  
  279. setp hm2_7i92.0.stepgen.02.dirsetup [AXIS_2]DIRSETUP
  280. setp hm2_7i92.0.stepgen.02.dirhold [AXIS_2]DIRHOLD
  281. setp hm2_7i92.0.stepgen.02.steplen [AXIS_2]STEPLEN
  282. setp hm2_7i92.0.stepgen.02.stepspace [AXIS_2]STEPSPACE
  283. setp hm2_7i92.0.stepgen.02.position-scale [AXIS_2]STEP_SCALE
  284. setp hm2_7i92.0.stepgen.02.step_type 0
  285. setp hm2_7i92.0.stepgen.02.control-type 1
  286. setp hm2_7i92.0.stepgen.02.maxaccel [AXIS_2]STEPGEN_MAXACCEL
  287. setp hm2_7i92.0.stepgen.02.maxvel [AXIS_2]STEPGEN_MAXVEL
  288.  
  289. # ---closedloop stepper signals---
  290.  
  291. net z-pos-cmd <= axis.2.motor-pos-cmd
  292. net z-vel-cmd <= axis.2.joint-vel-cmd
  293. net z-output <= hm2_7i92.0.stepgen.02.velocity-cmd
  294. net z-pos-fb <= hm2_7i92.0.stepgen.02.position-fb
  295. #net z-pos-fb <= hm2_7i92.0.encoder.03.position
  296. net z-pos-fb => axis.2.motor-pos-fb
  297. net z-enable <= axis.2.amp-enable-out
  298. net z-enable => hm2_7i92.0.stepgen.02.enable
  299.  
  300. # ---Encoder feedback signals/setup---
  301.  
  302. setp hm2_7i92.0.encoder.03.counter-mode 0
  303. setp hm2_7i92.0.encoder.03.filter 1
  304. setp hm2_7i92.0.encoder.03.index-invert 0
  305. setp hm2_7i92.0.encoder.03.index-mask 0
  306. setp hm2_7i92.0.encoder.03.index-mask-invert 0
  307. setp hm2_7i92.0.encoder.03.scale [AXIS_2]ENCODER_SCALE
  308.  
  309. # ****the following line is for drive tuning purposes only****
  310. net z-encpos-fb <= hm2_7i92.0.encoder.03.position
  311. net z-vel-fb <= hm2_7i92.0.encoder.03.velocity
  312. net z-pos-fb => axis.2.motor-pos-fb
  313. net z-index-enable axis.2.index-enable <=> hm2_7i92.0.encoder.03.index-enable
  314. net z-pos-rawcounts <= hm2_7i92.0.encoder.03.rawcounts
  315.  
  316. # ---setup home / limit switch signals---
  317.  
  318. net home-z => axis.2.home-sw-in
  319. net limit-z => axis.2.neg-lim-sw-in
  320.  
  321.  
  322. #*******************
  323. # AXIS A
  324. #*******************
  325.  
  326. setp pid.a.Pgain [AXIS_3]P
  327. setp pid.a.Igain [AXIS_3]I
  328. setp pid.a.Dgain [AXIS_3]D
  329. setp pid.a.bias [AXIS_3]BIAS
  330. setp pid.a.FF0 [AXIS_3]FF0
  331. setp pid.a.FF1 [AXIS_3]FF1
  332. setp pid.a.FF2 [AXIS_3]FF2
  333. setp pid.a.deadband [AXIS_3]DEADBAND
  334. setp pid.a.maxoutput [AXIS_3]MAX_OUTPUT
  335. setp pid.a.error-previous-target true
  336. setp pid.a.maxerror 0
  337.  
  338. net a-index-enable <=> pid.a.index-enable
  339. net a-enable => pid.a.enable
  340. net a-pos-cmd => pid.a.command
  341. net a-vel-cmd => pid.a.command-deriv
  342. net a-pos-fb => pid.a.feedback
  343. net a-output => pid.a.output
  344.  
  345. # Step Gen signals/setup
  346.  
  347. setp hm2_7i92.0.stepgen.03.dirsetup [AXIS_3]DIRSETUP
  348. setp hm2_7i92.0.stepgen.03.dirhold [AXIS_3]DIRHOLD
  349. setp hm2_7i92.0.stepgen.03.steplen [AXIS_3]STEPLEN
  350. setp hm2_7i92.0.stepgen.03.stepspace [AXIS_3]STEPSPACE
  351. setp hm2_7i92.0.stepgen.03.position-scale [AXIS_3]STEP_SCALE
  352. setp hm2_7i92.0.stepgen.03.step_type 0
  353. setp hm2_7i92.0.stepgen.03.control-type 1
  354. setp hm2_7i92.0.stepgen.03.maxaccel [AXIS_3]STEPGEN_MAXACCEL
  355. setp hm2_7i92.0.stepgen.03.maxvel [AXIS_3]STEPGEN_MAXVEL
  356.  
  357. # ---closedloop stepper signals---
  358.  
  359. net a-pos-cmd <= axis.3.motor-pos-cmd
  360. net a-vel-cmd <= axis.3.joint-vel-cmd
  361. net a-output <= hm2_7i92.0.stepgen.03.velocity-cmd
  362. net a-pos-fb <= hm2_7i92.0.encoder.04.position
  363. net a-pos-fb => axis.3.motor-pos-fb
  364. net a-enable <= axis.3.amp-enable-out
  365. net a-enable => hm2_7i92.0.stepgen.03.enable
  366.  
  367. # ---Encoder feedback signals/setup---
  368.  
  369. setp hm2_7i92.0.encoder.04.counter-mode 0
  370. setp hm2_7i92.0.encoder.04.filter 1
  371. setp hm2_7i92.0.encoder.04.index-invert 0
  372. setp hm2_7i92.0.encoder.04.index-mask 0
  373. setp hm2_7i92.0.encoder.04.index-mask-invert 0
  374. setp hm2_7i92.0.encoder.04.scale [AXIS_3]ENCODER_SCALE
  375.  
  376.  
  377. net a-vel-fb <= hm2_7i92.0.encoder.04.velocity
  378. net a-pos-fb => axis.3.motor-pos-fb
  379. net a-index-enable axis.3.index-enable <=> hm2_7i92.0.encoder.04.index-enable
  380. net a-pos-rawcounts <= hm2_7i92.0.encoder.04.rawcounts
  381.  
  382. # ---setup home / limit switch signals---
  383.  
  384. net a-home-sw => axis.3.home-sw-in
  385. net a-neg-limit => axis.3.neg-lim-sw-in
  386. net a-pos-limit => axis.3.pos-lim-sw-in
  387.  
  388. #*******************
  389. # SPINDLE S
  390. #*******************
  391.  
  392. setp pid.s.Pgain [SPINDLE_9]P
  393. setp pid.s.Igain [SPINDLE_9]I
  394. setp pid.s.Dgain [SPINDLE_9]D
  395. setp pid.s.bias [SPINDLE_9]BIAS
  396. setp pid.s.FF0 [SPINDLE_9]FF0
  397. setp pid.s.FF1 [SPINDLE_9]FF1
  398. setp pid.s.FF2 [SPINDLE_9]FF2
  399. setp pid.s.deadband [SPINDLE_9]DEADBAND
  400. setp pid.s.maxoutput [SPINDLE_9]MAX_OUTPUT
  401. setp pid.s.error-previous-target true
  402.  
  403. net spindle-index-enable <=> pid.s.index-enable
  404. net spindle-enable => pid.s.enable
  405. net spindle-vel-cmd-rpm => pid.s.command
  406. net spindle-vel-fb-rpm-abs => pid.s.feedback
  407. net spindle-output <= pid.s.output
  408.  
  409. # ---PWM Generator signals/setup---
  410.  
  411. setp hm2_7i92.0.7i77.0.1.analogout0-scalemax [SPINDLE_9]OUTPUT_SCALE
  412. setp hm2_7i92.0.7i77.0.1.analogout0-minlim [SPINDLE_9]OUTPUT_MIN_LIMIT
  413. setp hm2_7i92.0.7i77.0.1.analogout0-maxlim [SPINDLE_9]OUTPUT_MAX_LIMIT
  414.  
  415. net spindle-output => hm2_7i92.0.7i77.0.1.analogout0
  416. net spindle-enable hm2_7i92.0.7i77.0.1.analogena
  417.  
  418. # ---Encoder feedback signals/setup---
  419.  
  420. setp hm2_7i92.0.encoder.00.counter-mode 0
  421. setp hm2_7i92.0.encoder.00.filter 1
  422. setp hm2_7i92.0.encoder.00.index-invert 0
  423. setp hm2_7i92.0.encoder.00.index-mask 0
  424. setp hm2_7i92.0.encoder.00.index-mask-invert 0
  425. setp hm2_7i92.0.encoder.00.scale [SPINDLE_9]ENCODER_SCALE
  426.  
  427. net spindle-revs <= hm2_7i92.0.encoder.00.position
  428. net spindle-vel-fb-rps <= hm2_7i92.0.encoder.00.velocity
  429. net spindle-index-enable <=> hm2_7i92.0.encoder.00.index-enable
  430.  
  431. # ---setup spindle control signals---
  432.  
  433. net spindle-vel-cmd-rps <= motion.spindle-speed-out-rps
  434. net spindle-vel-cmd-rps-abs <= motion.spindle-speed-out-rps-abs
  435. net spindle-vel-cmd-rpm <= motion.spindle-speed-out
  436. net spindle-vel-cmd-rpm-abs <= motion.spindle-speed-out-abs
  437. net spindle-enable <= motion.spindle-on
  438. net spindle-cw <= motion.spindle-forward
  439. net spindle-ccw <= motion.spindle-reverse
  440. net spindle-brake <= motion.spindle-brake
  441. net spindle-revs => motion.spindle-revs
  442. net spindle-at-speed => motion.spindle-at-speed
  443. net spindle-vel-fb-rps => motion.spindle-speed-in
  444. net spindle-index-enable <=> motion.spindle-index-enable
  445.  
  446. # ---Setup spindle at speed signals---
  447.  
  448. net spindle-vel-cmd-rps => near.0.in1
  449. net spindle-vel-fb-rps => near.0.in2
  450.  
  451. ##########################
  452. net spindle-at-speed <= near.0.out
  453. ##########################
  454. setp near.0.scale 1.000000
  455. ##########################
  456. setp near.0.difference 5
  457.  
  458. ##sets spindle-at-speed true
  459.  
  460. # Use ACTUAL spindle velocity from spindle encoder
  461. # spindle-velocity bounces around so we filter it with lowpass
  462. # spindle-velocity is signed so we use absolute component to remove sign
  463. # ACTUAL velocity is in RPS not RPM so we scale it.
  464.  
  465. setp scale.spindle.gain 60
  466. setp lowpass.spindle.gain 1.000000
  467. net spindle-vel-fb-rps => scale.spindle.in
  468. net spindle-fb-rpm scale.spindle.out => abs.spindle.in
  469. net spindle-fb-rpm-abs abs.spindle.out => lowpass.spindle.in
  470. net spindle-fb-rpm-abs-filtered lowpass.spindle.out
  471.  
  472. # ---coolant signals---
  473. net coolant-mist <= iocontrol.0.coolant-mist
  474. net coolant-flood <= iocontrol.0.coolant-flood
  475.  
  476. # ---probe signal---
  477.  
  478. net probe-in => motion.probe-input
  479.  
  480. # ---motion control signals---
  481.  
  482. net in-position <= motion.in-position
  483. net machine-is-enabled <= motion.motion-enabled
  484.  
  485. # ---digital in / out signals---
  486.  
  487. # ---estop signals---
  488.  
  489. net estop-out <= iocontrol.0.user-enable-out
  490. net estop-ext => iocontrol.0.emc-enable-in
  491.  
  492. # ---manual tool change signals---
  493.  
  494. #loadusr -W hal_manualtoolchange
  495. #net tool-change-request iocontrol.0.tool-change => hal_manualtoolchange.change
  496. #net tool-change-confirmed iocontrol.0.tool-changed <= hal_manualtoolchange.changed
  497. #net tool-number iocontrol.0.tool-prep-number => hal_manualtoolchange.number
  498. net tool-prepare-loopback iocontrol.0.tool-prepare => iocontrol.0.tool-prepared
  499. net tool-change-loop iocontrol.0.tool-change => iocontrol.0.tool-changed
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement
Public Pastes
Advertisement
We use cookies for various purposes including analytics. By continuing to use Pastebin, you agree to our use of cookies as described in the Cookies Policy.  OK, I Understand
Not a member of Pastebin yet?
Sign Up, it unlocks many cool features!